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S2000 



SUBSTITUTE VALUES OF 2ND TURNING GAIT PARAMETER INCLUDING (Xs, Vxs, wbs, ZMPrecpeak) DETERMINED 
ONE STEP BEFORE INTO 1 ST TURNING GAIT PARAMETER, AND SUBSTITUTE VALUES OF 1ST TURNING GAIT 
PARAMETER DETERMINED ONE STEP BEFORE INTO 2ND TURNING GAIT PARAMETER. 
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BRING VALUES OF PRIORITY PARAMETERS OF NORMAL GAIT PARAMETER EXCLUDING (Xs, Vxs, tubs, ZMPrecpeak) 
CLOSE TO VALUES DETERMINED BY PROCESSING OF S022. 
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BASED ON NORMAL GAIT PARAMETER, SEARCH FOR NORMAL GAIT THAT SATISFIES BOUNDARY CONDITION 
AND DETERMINE (Xs, Vxs, a> bs, ZMPrecpeak). 



S2002-2 



BRING VALUES OF PRIORITY PARAMETERS OF NORMAL GAIT PARAMETER EXCLUDING (Xs, Vxs, wbs, ZMPrecpeak) 
FURTHER CLOSE TO VALUES DETERMINED BY PROCESSING OF S022. 
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BASED ON NORMAL GAIT PARAMETER, SEARCH FOR NORMAL GAIT THAT SATISFIES BOUNDARY CONDITION AND 
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MATCH VALUES OF PRIORITY PARAMETERS OF NORMAL GAIT PARAMETER EXCLUDING (Xs, Vxs, a>bs, ZMPrecpeak) 
WITH VALUES DETERMINED BY PROCESSING OF S022. 
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BASED ON NORMAL TURNING GAIT PARAMETER, DETERMINE INITIAL STATES (STATES AT INITIAL TIME Ts) 
OF FOOT POSITION/POSTURE, BODY POSTURE ANGLE e bs AND ARM POSTURES. 



TAKE CURRENT VALUES OF (Xs, Vxs, cobs, ZMPrecpeak) AS INITIAL VALUE CANDIDATES OF INITIAL (ATTs) 
BODY HORIZONTAL POSITION, VELOCITY, ANGULAR VELOCITY, AND BODY INCLINATION RESTORING 
MOMENT ZMP-CONVERTED VALUE PEAK VALUE. 
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DETERMINE INITIAL BODY VERTICAL POSITION/VELOCITY (Zs, Vzs). 
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USING DYNAMIC MODEL, GENERATE NORMAL GAIT ON THE BASIS OF NORMAL TURNING 

GAIT PARAMETER INCLUDING ZMPrecpeak, TAKING 6 bs,(Xs, Vxs, cobs), (Zs,Vzs) 

AS INITIAL STATES OF BODY. __ 
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(Xs, Vxs+ a Vxs, cubs, ZMPrecpeak), (Xs, Vxs, cobs+A cobs, ZMPrecpeak), 

(Xs, Vxs, cobs, ZMPrecpeak+ A ZMPrecpeak) IN THE VICINITY OF (Xs, Vxs, cobs, ZMPrecpeak), 

AND BASED ON THEM, DETERMINE BOUNDARY CONDITION ERROR CORRESPONDING 

TO EACH OF THEM AS DESCRIBED ABOVE. 
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DETERMINE NEW CANDIDATES (Xs, Vxs, cobs, ZMPrecpeak) ON THE BASIS OF BOUNDARY 
CONDITION ERRORS CORRESPONDING TO (Xs, Vxs, cobs, ZMPrecpeak) AND EACH OF 
CANDIDATES IN THE VICINITY THEREOF. 
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DETERMINE FLOOR REACTION FORCE VERTICAL COMPONENT 
TRAJECTORY PARAMETER OF CURRENT TIME GAIT. 



DETERMINE FLOOR REACTION FORCE HORIZONTAL 
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TAKE CURRENT VALUES OF (a, ZMPrecpeako, ZMPrecpeakb) AS INITIAL VALUE CANDIDATES OF ZMP 
CORRECTED PARAMETER CANDIDATE a AND BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED 
VALUE PEAK VALUE CANDIDATES (ZMPrecpeako, ZMPrecpeakb), RESPECTIVELY. 
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CALCULATE CURRENT TIME GAIT USING DYNAMIC MODEL UNTIL TERMINATING TIME ON THE 
BASIS OF PARAMETER OBTAINED BY CORRECTING CURRENT ZMP TRAJECTORY PARAMETER BY 
ZMP CORRECTED PARAMETER CANDIDATE a, BODY INCLINATION RESTORING MOMENT 
ZMP-CONVERTED VALUE PEAK VALUE CANDIDATES (ZMPrecpeako, ZMPrecpeakb), 
AND OTHER CURRENT TIME GAIT PARAMETERS. 



DETERMINE TERMINAL DIVERGENCE COMPONENT qO[k] ACCORDING TO THE FOLLOWING 
EXPRESSION FROM BODY POSITIONAELOCITY (Xe, Ve) 
AT TERMINATING END OF CURRENT TIME GAIT: 
qO[k] = Xe + Vxe/a;0 
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DETERMINE TERMINAL DIVERGENCE COMPONENT ERROR errq 
ACCORDING TO THE FOLLOWING EXPRESSION: 
errq = qO[k] - q" 
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TERMINAL BODY INCLINATION ANGLE ERROR 6 berr 
= NORMAL GAIT INITIAL BODY INCLINATION ANGLE 

- CURRENT TIME GAIT INITIAL BODY INCLINATION ANGLE 
TERMINAL BODY INCLINATION ANGULAR VELOCITY ERROR w berr 
= NORMAL GAIT INITIAL BODY INCLINATION ANGLE VELOCITY 

- CURRENT TIME GAIT INITIAL BODY INCLINATION ANGULAR VELOCITY 



S1710 



S1712 yes 



ARE ALL errq, 9 berr, AND m berr 
WITHIN PERMISSIBLE RANGES? 



I 



C LEAVE REPETITION LOOP.) 



S1714 



DETERMINE A PLURALITY OF INITIAL VALUE CANDIDATES (a+ A a, ZMPrecpeako, ZMPrecpeakb), 

(a, ZMPrecpeaka+ A ZMPrecpeako, ZMPrecpeakb), AND 

(a, ZMPrecpeako, ZMPrecpeokb+ A ZMPrecpeakb) IN THE VICINITY OF 

(a, ZMPrecpeako, ZMPrecpeakb), AND BASED ON THEM, DETERMINE ERRORS ASSOCIATED WITH 

EACH OF THEM AS DESCRIBED ABOVE. 



DETERMINE NEW PARAMETER CANDIDATES (a, ZMPrecpeako, ZMPrecpeakb) ON THE BASIS OF 
(a, ZMPrecpeako, ZMPrecpeakb) AND ERRORS ASSOCIATED WITH EACH OF INITIAL VALUE 
CANDIDATES IN THE VICINITY THEREOF. 
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PROVISIONALLY DETERMINE GAIT PARAMETER OF CURRENT TIME GAIT 
INCLUDING DESIRED FLOOR REACTION FORCE VERTICAL COMPONENT 



SUBROUTINE FOR CORRECTING CURRENT TIME GAIT PARAMETER 
(CORRECT CURRENT TIME GAIT PARAMETER SUCH THAT DIVERGENCE 
COMPONENT AT END OF CURRENT TIME GAIT AGREES WITH INITIAL 
DIVERGENCE COMPONENT OF NORMAL TURNING WftHfc) GrA j T 
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DETERMINE PARAMETERS OF ZMP PERMISSIBLE RANGE AND FLOOR 
REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE 
FOR FULL-MODEL CORRECTION. 
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SUBROUTINE FOR DETERMINING CURRENT TIME GAIT INSTANTANEOUS VALUE 
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DETERMINE ARM SWINGING OPERATION TO CANCEL SPIN FORCE 



S034 
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DETERMINE INSTANTANEOUS VALUES OF ZMP PERMISSIBLE RANGE AND FLOOR REACTION 
FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE FOR FULL-MODEL CORRECTION. 
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S2000 



SUBSTITUTE VALUES OF 2ND TURNING GAIT PARAMETER INCLUDING (Xs, Vxs, wbs, ZMPrecpe^k) DETERMINED 
ONE STEP BEFORE INTO 1ST TURNING GAIT PARAMETER, AND SUBSTITUTE VALUES OF 1ST TURNING GAIT 
PARAMETER DETERMINED ONE STEP BEFORE INTO 2ND TURNING GAIT PARAMETER. 



S2002-1 



BRING VALUES OF PRIORITY PARAMETERS OF NORMAL GAIT PARAMETER EXCLUDING (Xs, Vxs, wbs, ZMPrecpe*k) 
CLOSE TO VALUES DETERMINED BY PROCESSING OF S022. 
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S2004-1 



BASED ON NORMAL GAIT PARAMETER, SEARCH FOR NORMAL GAIT THAT SATISFIES BOUNDARY CONDITION 
AND DETERMINE (Xs, Vxs, wbs, ZMPrecpefek). 
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S2002-2 



BRING VALUES OF PRIORITY PARAMETERS OF NORMAL GAIT PARAMETER EXCLUDING (Xs, Vxs, wbs, ZMPrecpe>k) 
FURTHER CLOSE TO VALUES DETERMINED BY PROCESSING OF S022. a 



S2004-2 



BASED ON NORMAL GAIT PARAMETER, SEARCH FOR NORMAL GAIT THAT SATISFIES BOUNDARY CONDITION AND 
DETERMINE (Xs, Vxs, *> bs, ZMPrecpefck). 



S2002-n 



MATCH VALUES OF PRIORITY PARAMETERS OF NORMAL GAIT PARAMETER EXCLUDING (Xs, Vxs, wbs, ZMPrecpe&Jc) 
WITH VALUES DETERMINED BY PROCESSING OF S022. a 



S2004-n 



BASED ON NORMAL GAIT PARAMETER, SEARCH FOR NORMAL GAIT THAT SATISFIES BOUNDARY CONDITION 
AND DETERMINE (Xs, Vxs, oj bs, ZMPrecpetk). 



S2006 



BASED ON NORMAL TURNING GAIT, DETERMINE INITIAL BODY HORIZONTAL POSITION, VELOCITY, 
POSTURE ANGLE, ANGULAR VELOCITY (XO, VxO, e bO, ubO) AND INITIAL BODY VERTICAL POSITION 
AND VELOCITY (ZO, VzO) AT ORIGINAL INITIAL TIME 0. 



DETERMINE NORMAL TURNING INITIAL DIVERGENCE COMPONENT q[0] ACCORDING 
TO THE FOLLOWING EXPRESSION: 
q[0] = XO + VxO/a,0 
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DETERMINE q", WHICH IS THE VALUE OF NORMAL TURNING INITIAL DIVERGENCE COMPONENT q[0] 
OBSERVED FROM SUPPORTING LEG COORDINATE SYSTEM OF CURRENT TIME'S GAIT, AND (ZO",VzO"), 
WHICH ARE VALUES OF INITIAL BODY VERTICAL POSITION/VELOCITY OBSERVED FROM SUPPORTING LEG 
COORDINATE SYSTEM OF CURRENT TIME'S GAIT. 
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BASED ON NORMAL TURNING GAIT PARAMETER, DETERMINE INITIAL STATES (STATES AT INITIAL TIME Ts) 
OF FOOT POSITION/POSTURE, BODY POSTURE ANGLE e bs AND ARM POSTURES. 



TAKE CURRENT VALUES OF (Xs, Vxs, oj bs, ZMPrecpe^k) AS INITIAL VALUE CANDIDATES OF INITIAL (AT Ts) 
BODY HORIZONTAL POSITION, VELOCITY, ANGULAR VELOCITY, AND BODY INCLINATION RESTORING 
MOMENT ZMP-CONVERTED VALUE PEAK VALUE. 
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DETERMINE INITIAL BODY VERTICAL P0S1TI0NAEL0CITY (Zs, Vzs). 
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USING DYNAMIC MODEL, GENERATE NORMAL GAIT ON THE BASIS OF NORMAL TURNING 
GAIT PARAMETER INCLUDING ZMPrecpeek, TAKING 9 bs,(Xs, Vxs, cobs), (Zs,Vzs) 
AS INITIAL STATES OF BODY. ^ 
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CONVERT TERMINAL BODY HORIZONTAL POSITION, VELOCITY, POSTURE ANGLE, AND ANGULAR 
VELOCITY OF GENERATED GAIT INTO VALUES OBSERVED FROM SUPPORTING LEG COORDINATE SYSTEM 
OF NEXT STEP, AND DENOTE THE VALUES BY (Xe, Vxe, e be, oj be). 



BOUNDARY CONDITION ERRORS (errx, errv, erre , errcu) 
= (Xs, Vxs, ebs, ojbs)-(Xe, Vxe, 9 be, cobe) 
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DETERMINE A PLURALITY OF INmAL VALUE CANDIDATES (Xs+aXs, Vxs^wbs, ZMPrecpeeJc), 
(Xs, Vxs+ a Vxs, oj bs, ZMPrecpeejO, (Xs, Vxs, oj bs+ A co bs, ZMPrecpe^k), a 
(Xs, Vxs, oj bs, ZMPrecpe^ A ZMPrecpe«[k) IN THE VICINITY OF (Xs, Vxs, oj bs, ZMPrecpefck), 
AND BASED ON THEM, DETERMINE BOUNDARY CONDITION ERROR CORRESPONDING 
TO EACH OF THEM AS DESCRIBED ABOVE. 
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DETERMINE NEW CANDIDATES (Xs, Vxs, cobs, ZMPrecpeW ON THE BASIS OF BOUNDARY 
CONDITION ERRORS CORRESPONDING TO (Xs, Vxs, cubs, ZMPrecpe^k) AND EACH OF 
CANDIDATES IN THE VICINITY THEREOF. & 
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DETERMINE FOOT TRAJECTORY PARAMETER 
OF CURRENT TIME GAIT. 



S600 



DETERMINE REFERENCE BODY POSTURE TRAJECTORY 
PARAMETER OF CURRENT TIME GAIT. 
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DETERMINE ARM POSTURE TRAJECTORY PARAMETER 
OF CURRENT TIME GAIT. 
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DETERMINE FLOOR REACTION FORCE VERTICAL COMPONENT 
TRAJECTORY PARAMETER OF CURRENT TIME GAIT. 



DETERMINE FLOOR REACTION FORCE HORIZONTAL 
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OF CURRENT TIMEW. 
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TAKE CURRENT VALUES OF (a, ZMPrecpeeJca, ZMPrecpeeJ<b) AS INITIAL VALUE CANDIDATES OF ZMP 
CORRECTED PARAMETER CANDIDATE a AND BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED 
VALUE PEAK VALUE CANDIDATES (ZMPrecpefrko, ZMPrecpesJcb), RESPECTIVELY. 
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CALCULATE CURRENT TIME GAIT USING DYNAMIC MODEL UNTIL TERMINATING TIME ON THE 
BASIS OF PARAMETER OBTAINED BY CORRECTING CURRENT ZMP TRAJECTORY PARAMETER BY 
ZMP CORRECTED PARAMETER CANDIDATE a, BODY INCLINATION RESTORING MOMENT 
ZMP-CONVERTED VALUE PEAK VALUE CANDIDATES (ZMPrecpefctka, ZMPrecpeekb), 
AND OTHER CURRENT TIME GAIT PARAMETERS. & & 



DETERMINE TERMINAL DIVERGENCE COMPONENT qO[k] ACCORDING TO THE FOLLOWING 
EXPRESSION FROM BODY POSITIONAELOCITY (Xe, Ve) 
AT TERMINATING END OF CURRENT TIME GAIT: 
qO[k] = Xe + Vxe/a;0 
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DETERMINE TERMINAL DIVERGENCE COMPONENT ERROR errq 
ACCORDING TO THE FOLLOWING EXPRESSION: 
errq = qO[k] - q" 
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TERMINAL BODY INCLINATION ANGLE ERROR 9 berr 
= NORMAL GAIT INITIAL BODY INCLINATION ANGLE 

- CURRENT TIME GAIT INITIAL BODY INCLINATION ANGLE 
TERMINAL BODY INCLINATION ANGULAR VELOCITY ERROR a) berr 
= NORMAL GAIT INITIAL BODY INCLINATION ANGLE VELOCITY 

- CURRENT TIME GAIT INITIAL BODY INCLINATION ANGULAR VELOCITY 
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DETERMINE A PLURALITY OF INITIAL VALUE CANDIDATES (a+Aa, ZMPrecpe&a, ZMPrecpe^kb), 

(a, ZMPrecpe'eW A ZMPrecpe&a, ZMPrecp&kb), AND 

(a, ZMPrecp&ka, ZMPrecpe4b+ A ZMPrecp&kb) IN THE VICINITY OF 

(a, ZMPrecpefya, ZMPrecpeeJcb), AND BASED ON THEM, DETERMINE ERRORS ASSOCIATED WITH 

EACH OF THEM AS DESCRIBED ABOVE. 



DETERMINE NEW PARAMETER CANDIDATES (a, ZMPrecpeeJca, ZMPrecpeeJcb) ON THE BASIS OF 
(a, ZMPrecpeeJca, ZMPrecpeSkb) AND ERRORS ASSOCIATED WITH EACH OF INITIAL VALUE 
CANDIDATES IN THE VICINITY THEREOF. 
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